Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
* 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input: Input: add driver for Atmel AT42QT2160 Sensor Chip Input: max7359 - use threaded IRQs Input: add driver for Maxim MAX7359 key switch controller Input: add driver for ADP5588 QWERTY I2C Keypad Input: add touchscreen driver for MELFAS MCS-5000 controller Input: add driver for OpenCores Keyboard Controller Input: dm355evm_keys - remove dm355evm_keys_hardirq Input: synaptics_i2c - switch to using __cancel_delayed_work() Input: ad7879 - add support for AD7889 Input: atkbd - rely on input core to restore state on resume Input: add generic suspend and resume for input devices Input: libps2 - additional locking for i8042 ports
This commit is contained in:
@@ -24,6 +24,16 @@ config KEYBOARD_AAED2000
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called aaed2000_kbd.
|
||||
|
||||
config KEYBOARD_ADP5588
|
||||
tristate "ADP5588 I2C QWERTY Keypad and IO Expander"
|
||||
depends on I2C
|
||||
help
|
||||
Say Y here if you want to use a ADP5588 attached to your
|
||||
system I2C bus.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called adp5588-keys.
|
||||
|
||||
config KEYBOARD_AMIGA
|
||||
tristate "Amiga keyboard"
|
||||
depends on AMIGA
|
||||
@@ -104,6 +114,16 @@ config KEYBOARD_ATKBD_RDI_KEYCODES
|
||||
right-hand column will be interpreted as the key shown in the
|
||||
left-hand column.
|
||||
|
||||
config QT2160
|
||||
tristate "Atmel AT42QT2160 Touch Sensor Chip"
|
||||
depends on I2C && EXPERIMENTAL
|
||||
help
|
||||
If you say yes here you get support for Atmel AT42QT2160 Touch
|
||||
Sensor chip as a keyboard input.
|
||||
|
||||
This driver can also be built as a module. If so, the module
|
||||
will be called qt2160.
|
||||
|
||||
config KEYBOARD_BFIN
|
||||
tristate "Blackfin BF54x keypad support"
|
||||
depends on (BF54x && !BF544)
|
||||
@@ -251,6 +271,17 @@ config KEYBOARD_MAPLE
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called maple_keyb.
|
||||
|
||||
config KEYBOARD_MAX7359
|
||||
tristate "Maxim MAX7359 Key Switch Controller"
|
||||
depends on I2C
|
||||
help
|
||||
If you say yes here you get support for the Maxim MAX7359 Key
|
||||
Switch Controller chip. This providers microprocessors with
|
||||
management of up to 64 key switches
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called max7359_keypad.
|
||||
|
||||
config KEYBOARD_NEWTON
|
||||
tristate "Newton keyboard"
|
||||
select SERIO
|
||||
@@ -260,6 +291,15 @@ config KEYBOARD_NEWTON
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called newtonkbd.
|
||||
|
||||
config KEYBOARD_OPENCORES
|
||||
tristate "OpenCores Keyboard Controller"
|
||||
help
|
||||
Say Y here if you want to use the OpenCores Keyboard Controller
|
||||
http://www.opencores.org/project,keyboardcontroller
|
||||
|
||||
To compile this driver as a module, choose M here; the
|
||||
module will be called opencores-kbd.
|
||||
|
||||
config KEYBOARD_PXA27x
|
||||
tristate "PXA27x/PXA3xx keypad support"
|
||||
depends on PXA27x || PXA3xx
|
||||
|
@@ -5,6 +5,7 @@
|
||||
# Each configuration option enables a list of files.
|
||||
|
||||
obj-$(CONFIG_KEYBOARD_AAED2000) += aaed2000_kbd.o
|
||||
obj-$(CONFIG_KEYBOARD_ADP5588) += adp5588-keys.o
|
||||
obj-$(CONFIG_KEYBOARD_AMIGA) += amikbd.o
|
||||
obj-$(CONFIG_KEYBOARD_ATARI) += atakbd.o
|
||||
obj-$(CONFIG_KEYBOARD_ATKBD) += atkbd.o
|
||||
@@ -21,10 +22,13 @@ obj-$(CONFIG_KEYBOARD_LM8323) += lm8323.o
|
||||
obj-$(CONFIG_KEYBOARD_LOCOMO) += locomokbd.o
|
||||
obj-$(CONFIG_KEYBOARD_MAPLE) += maple_keyb.o
|
||||
obj-$(CONFIG_KEYBOARD_MATRIX) += matrix_keypad.o
|
||||
obj-$(CONFIG_KEYBOARD_MAX7359) += max7359_keypad.o
|
||||
obj-$(CONFIG_KEYBOARD_NEWTON) += newtonkbd.o
|
||||
obj-$(CONFIG_KEYBOARD_OMAP) += omap-keypad.o
|
||||
obj-$(CONFIG_KEYBOARD_OPENCORES) += opencores-kbd.o
|
||||
obj-$(CONFIG_KEYBOARD_PXA27x) += pxa27x_keypad.o
|
||||
obj-$(CONFIG_KEYBOARD_PXA930_ROTARY) += pxa930_rotary.o
|
||||
obj-$(CONFIG_KEYBOARD_QT2160) += qt2160.o
|
||||
obj-$(CONFIG_KEYBOARD_SH_KEYSC) += sh_keysc.o
|
||||
obj-$(CONFIG_KEYBOARD_SPITZ) += spitzkbd.o
|
||||
obj-$(CONFIG_KEYBOARD_STOWAWAY) += stowaway.o
|
||||
|
361
drivers/input/keyboard/adp5588-keys.c
Normal file
361
drivers/input/keyboard/adp5588-keys.c
Normal file
@@ -0,0 +1,361 @@
|
||||
/*
|
||||
* File: drivers/input/keyboard/adp5588_keys.c
|
||||
* Description: keypad driver for ADP5588 I2C QWERTY Keypad and IO Expander
|
||||
* Bugs: Enter bugs at http://blackfin.uclinux.org/
|
||||
*
|
||||
* Copyright (C) 2008-2009 Analog Devices Inc.
|
||||
* Licensed under the GPL-2 or later.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/version.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/pm.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/i2c.h>
|
||||
|
||||
#include <linux/i2c/adp5588.h>
|
||||
|
||||
/* Configuration Register1 */
|
||||
#define AUTO_INC (1 << 7)
|
||||
#define GPIEM_CFG (1 << 6)
|
||||
#define OVR_FLOW_M (1 << 5)
|
||||
#define INT_CFG (1 << 4)
|
||||
#define OVR_FLOW_IEN (1 << 3)
|
||||
#define K_LCK_IM (1 << 2)
|
||||
#define GPI_IEN (1 << 1)
|
||||
#define KE_IEN (1 << 0)
|
||||
|
||||
/* Interrupt Status Register */
|
||||
#define CMP2_INT (1 << 5)
|
||||
#define CMP1_INT (1 << 4)
|
||||
#define OVR_FLOW_INT (1 << 3)
|
||||
#define K_LCK_INT (1 << 2)
|
||||
#define GPI_INT (1 << 1)
|
||||
#define KE_INT (1 << 0)
|
||||
|
||||
/* Key Lock and Event Counter Register */
|
||||
#define K_LCK_EN (1 << 6)
|
||||
#define LCK21 0x30
|
||||
#define KEC 0xF
|
||||
|
||||
/* Key Event Register xy */
|
||||
#define KEY_EV_PRESSED (1 << 7)
|
||||
#define KEY_EV_MASK (0x7F)
|
||||
|
||||
#define KP_SEL(x) (0xFFFF >> (16 - x)) /* 2^x-1 */
|
||||
|
||||
#define KEYP_MAX_EVENT 10
|
||||
|
||||
/*
|
||||
* Early pre 4.0 Silicon required to delay readout by at least 25ms,
|
||||
* since the Event Counter Register updated 25ms after the interrupt
|
||||
* asserted.
|
||||
*/
|
||||
#define WA_DELAYED_READOUT_REVID(rev) ((rev) < 4)
|
||||
|
||||
struct adp5588_kpad {
|
||||
struct i2c_client *client;
|
||||
struct input_dev *input;
|
||||
struct delayed_work work;
|
||||
unsigned long delay;
|
||||
unsigned short keycode[ADP5588_KEYMAPSIZE];
|
||||
};
|
||||
|
||||
static int adp5588_read(struct i2c_client *client, u8 reg)
|
||||
{
|
||||
int ret = i2c_smbus_read_byte_data(client, reg);
|
||||
|
||||
if (ret < 0)
|
||||
dev_err(&client->dev, "Read Error\n");
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int adp5588_write(struct i2c_client *client, u8 reg, u8 val)
|
||||
{
|
||||
return i2c_smbus_write_byte_data(client, reg, val);
|
||||
}
|
||||
|
||||
static void adp5588_work(struct work_struct *work)
|
||||
{
|
||||
struct adp5588_kpad *kpad = container_of(work,
|
||||
struct adp5588_kpad, work.work);
|
||||
struct i2c_client *client = kpad->client;
|
||||
int i, key, status, ev_cnt;
|
||||
|
||||
status = adp5588_read(client, INT_STAT);
|
||||
|
||||
if (status & OVR_FLOW_INT) /* Unlikely and should never happen */
|
||||
dev_err(&client->dev, "Event Overflow Error\n");
|
||||
|
||||
if (status & KE_INT) {
|
||||
ev_cnt = adp5588_read(client, KEY_LCK_EC_STAT) & KEC;
|
||||
if (ev_cnt) {
|
||||
for (i = 0; i < ev_cnt; i++) {
|
||||
key = adp5588_read(client, Key_EVENTA + i);
|
||||
input_report_key(kpad->input,
|
||||
kpad->keycode[(key & KEY_EV_MASK) - 1],
|
||||
key & KEY_EV_PRESSED);
|
||||
}
|
||||
input_sync(kpad->input);
|
||||
}
|
||||
}
|
||||
adp5588_write(client, INT_STAT, status); /* Status is W1C */
|
||||
}
|
||||
|
||||
static irqreturn_t adp5588_irq(int irq, void *handle)
|
||||
{
|
||||
struct adp5588_kpad *kpad = handle;
|
||||
|
||||
/*
|
||||
* use keventd context to read the event fifo registers
|
||||
* Schedule readout at least 25ms after notification for
|
||||
* REVID < 4
|
||||
*/
|
||||
|
||||
schedule_delayed_work(&kpad->work, kpad->delay);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int __devinit adp5588_setup(struct i2c_client *client)
|
||||
{
|
||||
struct adp5588_kpad_platform_data *pdata = client->dev.platform_data;
|
||||
int i, ret;
|
||||
|
||||
ret = adp5588_write(client, KP_GPIO1, KP_SEL(pdata->rows));
|
||||
ret |= adp5588_write(client, KP_GPIO2, KP_SEL(pdata->cols) & 0xFF);
|
||||
ret |= adp5588_write(client, KP_GPIO3, KP_SEL(pdata->cols) >> 8);
|
||||
|
||||
if (pdata->en_keylock) {
|
||||
ret |= adp5588_write(client, UNLOCK1, pdata->unlock_key1);
|
||||
ret |= adp5588_write(client, UNLOCK2, pdata->unlock_key2);
|
||||
ret |= adp5588_write(client, KEY_LCK_EC_STAT, K_LCK_EN);
|
||||
}
|
||||
|
||||
for (i = 0; i < KEYP_MAX_EVENT; i++)
|
||||
ret |= adp5588_read(client, Key_EVENTA);
|
||||
|
||||
ret |= adp5588_write(client, INT_STAT, CMP2_INT | CMP1_INT |
|
||||
OVR_FLOW_INT | K_LCK_INT |
|
||||
GPI_INT | KE_INT); /* Status is W1C */
|
||||
|
||||
ret |= adp5588_write(client, CFG, INT_CFG | OVR_FLOW_IEN | KE_IEN);
|
||||
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "Write Error\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devinit adp5588_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct adp5588_kpad *kpad;
|
||||
struct adp5588_kpad_platform_data *pdata = client->dev.platform_data;
|
||||
struct input_dev *input;
|
||||
unsigned int revid;
|
||||
int ret, i;
|
||||
int error;
|
||||
|
||||
if (!i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_BYTE_DATA)) {
|
||||
dev_err(&client->dev, "SMBUS Byte Data not Supported\n");
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
if (!pdata) {
|
||||
dev_err(&client->dev, "no platform data?\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (!pdata->rows || !pdata->cols || !pdata->keymap) {
|
||||
dev_err(&client->dev, "no rows, cols or keymap from pdata\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (pdata->keymapsize != ADP5588_KEYMAPSIZE) {
|
||||
dev_err(&client->dev, "invalid keymapsize\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (!client->irq) {
|
||||
dev_err(&client->dev, "no IRQ?\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
kpad = kzalloc(sizeof(*kpad), GFP_KERNEL);
|
||||
input = input_allocate_device();
|
||||
if (!kpad || !input) {
|
||||
error = -ENOMEM;
|
||||
goto err_free_mem;
|
||||
}
|
||||
|
||||
kpad->client = client;
|
||||
kpad->input = input;
|
||||
INIT_DELAYED_WORK(&kpad->work, adp5588_work);
|
||||
|
||||
ret = adp5588_read(client, DEV_ID);
|
||||
if (ret < 0) {
|
||||
error = ret;
|
||||
goto err_free_mem;
|
||||
}
|
||||
|
||||
revid = (u8) ret & ADP5588_DEVICE_ID_MASK;
|
||||
if (WA_DELAYED_READOUT_REVID(revid))
|
||||
kpad->delay = msecs_to_jiffies(30);
|
||||
|
||||
input->name = client->name;
|
||||
input->phys = "adp5588-keys/input0";
|
||||
input->dev.parent = &client->dev;
|
||||
|
||||
input_set_drvdata(input, kpad);
|
||||
|
||||
input->id.bustype = BUS_I2C;
|
||||
input->id.vendor = 0x0001;
|
||||
input->id.product = 0x0001;
|
||||
input->id.version = revid;
|
||||
|
||||
input->keycodesize = sizeof(kpad->keycode[0]);
|
||||
input->keycodemax = pdata->keymapsize;
|
||||
input->keycode = kpad->keycode;
|
||||
|
||||
memcpy(kpad->keycode, pdata->keymap,
|
||||
pdata->keymapsize * input->keycodesize);
|
||||
|
||||
/* setup input device */
|
||||
__set_bit(EV_KEY, input->evbit);
|
||||
|
||||
if (pdata->repeat)
|
||||
__set_bit(EV_REP, input->evbit);
|
||||
|
||||
for (i = 0; i < input->keycodemax; i++)
|
||||
__set_bit(kpad->keycode[i] & KEY_MAX, input->keybit);
|
||||
__clear_bit(KEY_RESERVED, input->keybit);
|
||||
|
||||
error = input_register_device(input);
|
||||
if (error) {
|
||||
dev_err(&client->dev, "unable to register input device\n");
|
||||
goto err_free_mem;
|
||||
}
|
||||
|
||||
error = request_irq(client->irq, adp5588_irq,
|
||||
IRQF_TRIGGER_FALLING | IRQF_DISABLED,
|
||||
client->dev.driver->name, kpad);
|
||||
if (error) {
|
||||
dev_err(&client->dev, "irq %d busy?\n", client->irq);
|
||||
goto err_unreg_dev;
|
||||
}
|
||||
|
||||
error = adp5588_setup(client);
|
||||
if (error)
|
||||
goto err_free_irq;
|
||||
|
||||
device_init_wakeup(&client->dev, 1);
|
||||
i2c_set_clientdata(client, kpad);
|
||||
|
||||
dev_info(&client->dev, "Rev.%d keypad, irq %d\n", revid, client->irq);
|
||||
return 0;
|
||||
|
||||
err_free_irq:
|
||||
free_irq(client->irq, kpad);
|
||||
err_unreg_dev:
|
||||
input_unregister_device(input);
|
||||
input = NULL;
|
||||
err_free_mem:
|
||||
input_free_device(input);
|
||||
kfree(kpad);
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
static int __devexit adp5588_remove(struct i2c_client *client)
|
||||
{
|
||||
struct adp5588_kpad *kpad = i2c_get_clientdata(client);
|
||||
|
||||
adp5588_write(client, CFG, 0);
|
||||
free_irq(client->irq, kpad);
|
||||
cancel_delayed_work_sync(&kpad->work);
|
||||
input_unregister_device(kpad->input);
|
||||
i2c_set_clientdata(client, NULL);
|
||||
kfree(kpad);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PM
|
||||
static int adp5588_suspend(struct device *dev)
|
||||
{
|
||||
struct adp5588_kpad *kpad = dev_get_drvdata(dev);
|
||||
struct i2c_client *client = kpad->client;
|
||||
|
||||
disable_irq(client->irq);
|
||||
cancel_delayed_work_sync(&kpad->work);
|
||||
|
||||
if (device_may_wakeup(&client->dev))
|
||||
enable_irq_wake(client->irq);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int adp5588_resume(struct device *dev)
|
||||
{
|
||||
struct adp5588_kpad *kpad = dev_get_drvdata(dev);
|
||||
struct i2c_client *client = kpad->client;
|
||||
|
||||
if (device_may_wakeup(&client->dev))
|
||||
disable_irq_wake(client->irq);
|
||||
|
||||
enable_irq(client->irq);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct dev_pm_ops adp5588_dev_pm_ops = {
|
||||
.suspend = adp5588_suspend,
|
||||
.resume = adp5588_resume,
|
||||
};
|
||||
#endif
|
||||
|
||||
static const struct i2c_device_id adp5588_id[] = {
|
||||
{ KBUILD_MODNAME, 0 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, adp5588_id);
|
||||
|
||||
static struct i2c_driver adp5588_driver = {
|
||||
.driver = {
|
||||
.name = KBUILD_MODNAME,
|
||||
#ifdef CONFIG_PM
|
||||
.pm = &adp5588_dev_pm_ops,
|
||||
#endif
|
||||
},
|
||||
.probe = adp5588_probe,
|
||||
.remove = __devexit_p(adp5588_remove),
|
||||
.id_table = adp5588_id,
|
||||
};
|
||||
|
||||
static int __init adp5588_init(void)
|
||||
{
|
||||
return i2c_add_driver(&adp5588_driver);
|
||||
}
|
||||
module_init(adp5588_init);
|
||||
|
||||
static void __exit adp5588_exit(void)
|
||||
{
|
||||
i2c_del_driver(&adp5588_driver);
|
||||
}
|
||||
module_exit(adp5588_exit);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
|
||||
MODULE_DESCRIPTION("ADP5588 Keypad driver");
|
||||
MODULE_ALIAS("platform:adp5588-keys");
|
@@ -773,23 +773,6 @@ static int atkbd_select_set(struct atkbd *atkbd, int target_set, int allow_extra
|
||||
static int atkbd_activate(struct atkbd *atkbd)
|
||||
{
|
||||
struct ps2dev *ps2dev = &atkbd->ps2dev;
|
||||
unsigned char param[1];
|
||||
|
||||
/*
|
||||
* Set the LEDs to a defined state.
|
||||
*/
|
||||
|
||||
param[0] = 0;
|
||||
if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
|
||||
return -1;
|
||||
|
||||
/*
|
||||
* Set autorepeat to fastest possible.
|
||||
*/
|
||||
|
||||
param[0] = 0;
|
||||
if (ps2_command(ps2dev, param, ATKBD_CMD_SETREP))
|
||||
return -1;
|
||||
|
||||
/*
|
||||
* Enable the keyboard to receive keystrokes.
|
||||
@@ -1158,14 +1141,6 @@ static int atkbd_reconnect(struct serio *serio)
|
||||
return -1;
|
||||
|
||||
atkbd_activate(atkbd);
|
||||
|
||||
/*
|
||||
* Restore repeat rate and LEDs (that were reset by atkbd_activate)
|
||||
* to pre-resume state
|
||||
*/
|
||||
if (!atkbd->softrepeat)
|
||||
atkbd_set_repeat_rate(atkbd);
|
||||
atkbd_set_leds(atkbd);
|
||||
}
|
||||
|
||||
atkbd_enable(atkbd);
|
||||
|
330
drivers/input/keyboard/max7359_keypad.c
Normal file
330
drivers/input/keyboard/max7359_keypad.c
Normal file
@@ -0,0 +1,330 @@
|
||||
/*
|
||||
* max7359_keypad.c - MAX7359 Key Switch Controller Driver
|
||||
*
|
||||
* Copyright (C) 2009 Samsung Electronics
|
||||
* Kim Kyuwon <q1.kim@samsung.com>
|
||||
*
|
||||
* Based on pxa27x_keypad.c
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* Datasheet: http://www.maxim-ic.com/quick_view2.cfm/qv_pk/5456
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/input/matrix_keypad.h>
|
||||
|
||||
#define MAX7359_MAX_KEY_ROWS 8
|
||||
#define MAX7359_MAX_KEY_COLS 8
|
||||
#define MAX7359_MAX_KEY_NUM (MAX7359_MAX_KEY_ROWS * MAX7359_MAX_KEY_COLS)
|
||||
#define MAX7359_ROW_SHIFT 3
|
||||
|
||||
/*
|
||||
* MAX7359 registers
|
||||
*/
|
||||
#define MAX7359_REG_KEYFIFO 0x00
|
||||
#define MAX7359_REG_CONFIG 0x01
|
||||
#define MAX7359_REG_DEBOUNCE 0x02
|
||||
#define MAX7359_REG_INTERRUPT 0x03
|
||||
#define MAX7359_REG_PORTS 0x04
|
||||
#define MAX7359_REG_KEYREP 0x05
|
||||
#define MAX7359_REG_SLEEP 0x06
|
||||
|
||||
/*
|
||||
* Configuration register bits
|
||||
*/
|
||||
#define MAX7359_CFG_SLEEP (1 << 7)
|
||||
#define MAX7359_CFG_INTERRUPT (1 << 5)
|
||||
#define MAX7359_CFG_KEY_RELEASE (1 << 3)
|
||||
#define MAX7359_CFG_WAKEUP (1 << 1)
|
||||
#define MAX7359_CFG_TIMEOUT (1 << 0)
|
||||
|
||||
/*
|
||||
* Autosleep register values (ms)
|
||||
*/
|
||||
#define MAX7359_AUTOSLEEP_8192 0x01
|
||||
#define MAX7359_AUTOSLEEP_4096 0x02
|
||||
#define MAX7359_AUTOSLEEP_2048 0x03
|
||||
#define MAX7359_AUTOSLEEP_1024 0x04
|
||||
#define MAX7359_AUTOSLEEP_512 0x05
|
||||
#define MAX7359_AUTOSLEEP_256 0x06
|
||||
|
||||
struct max7359_keypad {
|
||||
/* matrix key code map */
|
||||
unsigned short keycodes[MAX7359_MAX_KEY_NUM];
|
||||
|
||||
struct input_dev *input_dev;
|
||||
struct i2c_client *client;
|
||||
};
|
||||
|
||||
static int max7359_write_reg(struct i2c_client *client, u8 reg, u8 val)
|
||||
{
|
||||
int ret = i2c_smbus_write_byte_data(client, reg, val);
|
||||
|
||||
if (ret < 0)
|
||||
dev_err(&client->dev, "%s: reg 0x%x, val 0x%x, err %d\n",
|
||||
__func__, reg, val, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int max7359_read_reg(struct i2c_client *client, int reg)
|
||||
{
|
||||
int ret = i2c_smbus_read_byte_data(client, reg);
|
||||
|
||||
if (ret < 0)
|
||||
dev_err(&client->dev, "%s: reg 0x%x, err %d\n",
|
||||
__func__, reg, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void max7359_build_keycode(struct max7359_keypad *keypad,
|
||||
const struct matrix_keymap_data *keymap_data)
|
||||
{
|
||||
struct input_dev *input_dev = keypad->input_dev;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < keymap_data->keymap_size; i++) {
|
||||
unsigned int key = keymap_data->keymap[i];
|
||||
unsigned int row = KEY_ROW(key);
|
||||
unsigned int col = KEY_COL(key);
|
||||
unsigned int scancode = MATRIX_SCAN_CODE(row, col,
|
||||
MAX7359_ROW_SHIFT);
|
||||
unsigned short keycode = KEY_VAL(key);
|
||||
|
||||
keypad->keycodes[scancode] = keycode;
|
||||
__set_bit(keycode, input_dev->keybit);
|
||||
}
|
||||
__clear_bit(KEY_RESERVED, input_dev->keybit);
|
||||
}
|
||||
|
||||
/* runs in an IRQ thread -- can (and will!) sleep */
|
||||
static irqreturn_t max7359_interrupt(int irq, void *dev_id)
|
||||
{
|
||||
struct max7359_keypad *keypad = dev_id;
|
||||
struct input_dev *input_dev = keypad->input_dev;
|
||||
int val, row, col, release, code;
|
||||
|
||||
val = max7359_read_reg(keypad->client, MAX7359_REG_KEYFIFO);
|
||||
row = val & 0x7;
|
||||
col = (val >> 3) & 0x7;
|
||||
release = val & 0x40;
|
||||
|
||||
code = MATRIX_SCAN_CODE(row, col, MAX7359_ROW_SHIFT);
|
||||
|
||||
dev_dbg(&keypad->client->dev,
|
||||
"key[%d:%d] %s\n", row, col, release ? "release" : "press");
|
||||
|
||||
input_event(input_dev, EV_MSC, MSC_SCAN, code);
|
||||
input_report_key(input_dev, keypad->keycodes[code], !release);
|
||||
input_sync(input_dev);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
/*
|
||||
* Let MAX7359 fall into a deep sleep:
|
||||
* If no keys are pressed, enter sleep mode for 8192 ms. And if any
|
||||
* key is pressed, the MAX7359 returns to normal operating mode.
|
||||
*/
|
||||
static inline void max7359_fall_deepsleep(struct i2c_client *client)
|
||||
{
|
||||
max7359_write_reg(client, MAX7359_REG_SLEEP, MAX7359_AUTOSLEEP_8192);
|
||||
}
|
||||
|
||||
/*
|
||||
* Let MAX7359 take a catnap:
|
||||
* Autosleep just for 256 ms.
|
||||
*/
|
||||
static inline void max7359_take_catnap(struct i2c_client *client)
|
||||
{
|
||||
max7359_write_reg(client, MAX7359_REG_SLEEP, MAX7359_AUTOSLEEP_256);
|
||||
}
|
||||
|
||||
static int max7359_open(struct input_dev *dev)
|
||||
{
|
||||
struct max7359_keypad *keypad = input_get_drvdata(dev);
|
||||
|
||||
max7359_take_catnap(keypad->client);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void max7359_close(struct input_dev *dev)
|
||||
{
|
||||
struct max7359_keypad *keypad = input_get_drvdata(dev);
|
||||
|
||||
max7359_fall_deepsleep(keypad->client);
|
||||
}
|
||||
|
||||
static void max7359_initialize(struct i2c_client *client)
|
||||
{
|
||||
max7359_write_reg(client, MAX7359_REG_CONFIG,
|
||||
MAX7359_CFG_INTERRUPT | /* Irq clears after host read */
|
||||
MAX7359_CFG_KEY_RELEASE | /* Key release enable */
|
||||
MAX7359_CFG_WAKEUP); /* Key press wakeup enable */
|
||||
|
||||
/* Full key-scan functionality */
|
||||
max7359_write_reg(client, MAX7359_REG_DEBOUNCE, 0x1F);
|
||||
|
||||
/* nINT asserts every debounce cycles */
|
||||
max7359_write_reg(client, MAX7359_REG_INTERRUPT, 0x01);
|
||||
|
||||
max7359_fall_deepsleep(client);
|
||||
}
|
||||
|
||||
static int __devinit max7359_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
const struct matrix_keymap_data *keymap_data = client->dev.platform_data;
|
||||
struct max7359_keypad *keypad;
|
||||
struct input_dev *input_dev;
|
||||
int ret;
|
||||
int error;
|
||||
|
||||
if (!client->irq) {
|
||||
dev_err(&client->dev, "The irq number should not be zero\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* Detect MAX7359: The initial Keys FIFO value is '0x3F' */
|
||||
ret = max7359_read_reg(client, MAX7359_REG_KEYFIFO);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "failed to detect device\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
dev_dbg(&client->dev, "keys FIFO is 0x%02x\n", ret);
|
||||
|
||||
keypad = kzalloc(sizeof(struct max7359_keypad), GFP_KERNEL);
|
||||
input_dev = input_allocate_device();
|
||||
if (!keypad || !input_dev) {
|
||||
dev_err(&client->dev, "failed to allocate memory\n");
|
||||
error = -ENOMEM;
|
||||
goto failed_free_mem;
|
||||
}
|
||||
|
||||
keypad->client = client;
|
||||
keypad->input_dev = input_dev;
|
||||
|
||||
input_dev->name = client->name;
|
||||
input_dev->id.bustype = BUS_I2C;
|
||||
input_dev->open = max7359_open;
|
||||
input_dev->close = max7359_close;
|
||||
input_dev->dev.parent = &client->dev;
|
||||
|
||||
input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
|
||||
input_dev->keycodesize = sizeof(keypad->keycodes[0]);
|
||||
input_dev->keycodemax = ARRAY_SIZE(keypad->keycodes);
|
||||
input_dev->keycode = keypad->keycodes;
|
||||
|
||||
input_set_capability(input_dev, EV_MSC, MSC_SCAN);
|
||||
input_set_drvdata(input_dev, keypad);
|
||||
|
||||
max7359_build_keycode(keypad, keymap_data);
|
||||
|
||||
error = request_threaded_irq(client->irq, NULL, max7359_interrupt,
|
||||
IRQF_TRIGGER_LOW | IRQF_ONESHOT,
|
||||
client->name, keypad);
|
||||
if (error) {
|
||||
dev_err(&client->dev, "failed to register interrupt\n");
|
||||
goto failed_free_mem;
|
||||
}
|
||||
|
||||
/* Register the input device */
|
||||
error = input_register_device(input_dev);
|
||||
if (error) {
|
||||
dev_err(&client->dev, "failed to register input device\n");
|
||||
goto failed_free_irq;
|
||||
}
|
||||
|
||||
/* Initialize MAX7359 */
|
||||
max7359_initialize(client);
|
||||
|
||||
i2c_set_clientdata(client, keypad);
|
||||
device_init_wakeup(&client->dev, 1);
|
||||
|
||||
return 0;
|
||||
|
||||
failed_free_irq:
|
||||
free_irq(client->irq, keypad);
|
||||
failed_free_mem:
|
||||
input_free_device(input_dev);
|
||||
kfree(keypad);
|
||||
return error;
|
||||
}
|
||||
|
||||
static int __devexit max7359_remove(struct i2c_client *client)
|
||||
{
|
||||
struct max7359_keypad *keypad = i2c_get_clientdata(client);
|
||||
|
||||
free_irq(client->irq, keypad);
|
||||
input_unregister_device(keypad->input_dev);
|
||||
i2c_set_clientdata(client, NULL);
|
||||
kfree(keypad);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PM
|
||||
static int max7359_suspend(struct i2c_client *client, pm_message_t mesg)
|
||||
{
|
||||
max7359_fall_deepsleep(client);
|
||||
|
||||
if (device_may_wakeup(&client->dev))
|
||||
enable_irq_wake(client->irq);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int max7359_resume(struct i2c_client *client)
|
||||
{
|
||||
if (device_may_wakeup(&client->dev))
|
||||
disable_irq_wake(client->irq);
|
||||
|
||||
/* Restore the default setting */
|
||||
max7359_take_catnap(client);
|
||||
|
||||
return 0;
|
||||
}
|
||||
#else
|
||||
#define max7359_suspend NULL
|
||||
#define max7359_resume NULL
|
||||
#endif
|
||||
|
||||
static const struct i2c_device_id max7359_ids[] = {
|
||||
{ "max7359", 0 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, max7359_ids);
|
||||
|
||||
static struct i2c_driver max7359_i2c_driver = {
|
||||
.driver = {
|
||||
.name = "max7359",
|
||||
},
|
||||
.probe = max7359_probe,
|
||||
.remove = __devexit_p(max7359_remove),
|
||||
.suspend = max7359_suspend,
|
||||
.resume = max7359_resume,
|
||||
.id_table = max7359_ids,
|
||||
};
|
||||
|
||||
static int __init max7359_init(void)
|
||||
{
|
||||
return i2c_add_driver(&max7359_i2c_driver);
|
||||
}
|
||||
module_init(max7359_init);
|
||||
|
||||
static void __exit max7359_exit(void)
|
||||
{
|
||||
i2c_del_driver(&max7359_i2c_driver);
|
||||
}
|
||||
module_exit(max7359_exit);
|
||||
|
||||
MODULE_AUTHOR("Kim Kyuwon <q1.kim@samsung.com>");
|
||||
MODULE_DESCRIPTION("MAX7359 Key Switch Controller Driver");
|
||||
MODULE_LICENSE("GPL v2");
|
180
drivers/input/keyboard/opencores-kbd.c
Normal file
180
drivers/input/keyboard/opencores-kbd.c
Normal file
@@ -0,0 +1,180 @@
|
||||
/*
|
||||
* OpenCores Keyboard Controller Driver
|
||||
* http://www.opencores.org/project,keyboardcontroller
|
||||
*
|
||||
* Copyright 2007-2009 HV Sistemas S.L.
|
||||
*
|
||||
* Licensed under the GPL-2 or later.
|
||||
*/
|
||||
|
||||
#include <linux/input.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/ioport.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/platform_device.h>
|
||||
|
||||
struct opencores_kbd {
|
||||
struct input_dev *input;
|
||||
struct resource *addr_res;
|
||||
void __iomem *addr;
|
||||
int irq;
|
||||
unsigned short keycodes[128];
|
||||
};
|
||||
|
||||
static irqreturn_t opencores_kbd_isr(int irq, void *dev_id)
|
||||
{
|
||||
struct opencores_kbd *opencores_kbd = dev_id;
|
||||
struct input_dev *input = opencores_kbd->input;
|
||||
unsigned char c;
|
||||
|
||||
c = readb(opencores_kbd->addr);
|
||||
input_report_key(input, c & 0x7f, c & 0x80 ? 0 : 1);
|
||||
input_sync(input);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int __devinit opencores_kbd_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct input_dev *input;
|
||||
struct opencores_kbd *opencores_kbd;
|
||||
struct resource *res;
|
||||
int irq, i, error;
|
||||
|
||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
if (!res) {
|
||||
dev_err(&pdev->dev, "missing board memory resource\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
irq = platform_get_irq(pdev, 0);
|
||||
if (irq < 0) {
|
||||
dev_err(&pdev->dev, "missing board IRQ resource\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
opencores_kbd = kzalloc(sizeof(*opencores_kbd), GFP_KERNEL);
|
||||
input = input_allocate_device();
|
||||
if (!opencores_kbd || !input) {
|
||||
dev_err(&pdev->dev, "failed to allocate device structures\n");
|
||||
error = -ENOMEM;
|
||||
goto err_free_mem;
|
||||
}
|
||||
|
||||
opencores_kbd->addr_res = res;
|
||||
res = request_mem_region(res->start, resource_size(res), pdev->name);
|
||||
if (!res) {
|
||||
dev_err(&pdev->dev, "failed to request I/O memory\n");
|
||||
error = -EBUSY;
|
||||
goto err_free_mem;
|
||||
}
|
||||
|
||||
opencores_kbd->addr = ioremap(res->start, resource_size(res));
|
||||
if (!opencores_kbd->addr) {
|
||||
dev_err(&pdev->dev, "failed to remap I/O memory\n");
|
||||
error = -ENXIO;
|
||||
goto err_rel_mem;
|
||||
}
|
||||
|
||||
opencores_kbd->input = input;
|
||||
opencores_kbd->irq = irq;
|
||||
|
||||
input->name = pdev->name;
|
||||
input->phys = "opencores-kbd/input0";
|
||||
input->dev.parent = &pdev->dev;
|
||||
|
||||
input_set_drvdata(input, opencores_kbd);
|
||||
|
||||
input->id.bustype = BUS_HOST;
|
||||
input->id.vendor = 0x0001;
|
||||
input->id.product = 0x0001;
|
||||
input->id.version = 0x0100;
|
||||
|
||||
input->keycode = opencores_kbd->keycodes;
|
||||
input->keycodesize = sizeof(opencores_kbd->keycodes[0]);
|
||||
input->keycodemax = ARRAY_SIZE(opencores_kbd->keycodes);
|
||||
|
||||
__set_bit(EV_KEY, input->evbit);
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(opencores_kbd->keycodes); i++) {
|
||||
/*
|
||||
* OpenCores controller happens to have scancodes match
|
||||
* our KEY_* definitions.
|
||||
*/
|
||||
opencores_kbd->keycodes[i] = i;
|
||||
__set_bit(opencores_kbd->keycodes[i], input->keybit);
|
||||
}
|
||||
__clear_bit(KEY_RESERVED, input->keybit);
|
||||
|
||||
error = request_irq(irq, &opencores_kbd_isr,
|
||||
IRQF_TRIGGER_RISING, pdev->name, opencores_kbd);
|
||||
if (error) {
|
||||
dev_err(&pdev->dev, "unable to claim irq %d\n", irq);
|
||||
goto err_unmap_mem;
|
||||
}
|
||||
|
||||
error = input_register_device(input);
|
||||
if (error) {
|
||||
dev_err(&pdev->dev, "unable to register input device\n");
|
||||
goto err_free_irq;
|
||||
}
|
||||
|
||||
platform_set_drvdata(pdev, opencores_kbd);
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_irq:
|
||||
free_irq(irq, opencores_kbd);
|
||||
err_unmap_mem:
|
||||
iounmap(opencores_kbd->addr);
|
||||
err_rel_mem:
|
||||
release_mem_region(res->start, resource_size(res));
|
||||
err_free_mem:
|
||||
input_free_device(input);
|
||||
kfree(opencores_kbd);
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
static int __devexit opencores_kbd_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct opencores_kbd *opencores_kbd = platform_get_drvdata(pdev);
|
||||
|
||||
free_irq(opencores_kbd->irq, opencores_kbd);
|
||||
|
||||
iounmap(opencores_kbd->addr);
|
||||
release_mem_region(opencores_kbd->addr_res->start,
|
||||
resource_size(opencores_kbd->addr_res));
|
||||
input_unregister_device(opencores_kbd->input);
|
||||
kfree(opencores_kbd);
|
||||
|
||||
platform_set_drvdata(pdev, NULL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct platform_driver opencores_kbd_device_driver = {
|
||||
.probe = opencores_kbd_probe,
|
||||
.remove = __devexit_p(opencores_kbd_remove),
|
||||
.driver = {
|
||||
.name = "opencores-kbd",
|
||||
},
|
||||
};
|
||||
|
||||
static int __init opencores_kbd_init(void)
|
||||
{
|
||||
return platform_driver_register(&opencores_kbd_device_driver);
|
||||
}
|
||||
module_init(opencores_kbd_init);
|
||||
|
||||
static void __exit opencores_kbd_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&opencores_kbd_device_driver);
|
||||
}
|
||||
module_exit(opencores_kbd_exit);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Javier Herrero <jherrero@hvsistemas.es>");
|
||||
MODULE_DESCRIPTION("Keyboard driver for OpenCores Keyboard Controller");
|
397
drivers/input/keyboard/qt2160.c
Normal file
397
drivers/input/keyboard/qt2160.c
Normal file
@@ -0,0 +1,397 @@
|
||||
/*
|
||||
* qt2160.c - Atmel AT42QT2160 Touch Sense Controller
|
||||
*
|
||||
* Copyright (C) 2009 Raphael Derosso Pereira <raphaelpereira@gmail.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* 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/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/jiffies.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/input.h>
|
||||
|
||||
#define QT2160_VALID_CHIPID 0x11
|
||||
|
||||
#define QT2160_CMD_CHIPID 0
|
||||
#define QT2160_CMD_CODEVER 1
|
||||
#define QT2160_CMD_GSTAT 2
|
||||
#define QT2160_CMD_KEYS3 3
|
||||
#define QT2160_CMD_KEYS4 4
|
||||
#define QT2160_CMD_SLIDE 5
|
||||
#define QT2160_CMD_GPIOS 6
|
||||
#define QT2160_CMD_SUBVER 7
|
||||
#define QT2160_CMD_CALIBRATE 10
|
||||
|
||||
#define QT2160_CYCLE_INTERVAL (2*HZ)
|
||||
|
||||
static unsigned char qt2160_key2code[] = {
|
||||
KEY_0, KEY_1, KEY_2, KEY_3,
|
||||
KEY_4, KEY_5, KEY_6, KEY_7,
|
||||
KEY_8, KEY_9, KEY_A, KEY_B,
|
||||
KEY_C, KEY_D, KEY_E, KEY_F,
|
||||
};
|
||||
|
||||
struct qt2160_data {
|
||||
struct i2c_client *client;
|
||||
struct input_dev *input;
|
||||
struct delayed_work dwork;
|
||||
spinlock_t lock; /* Protects canceling/rescheduling of dwork */
|
||||
unsigned short keycodes[ARRAY_SIZE(qt2160_key2code)];
|
||||
u16 key_matrix;
|
||||
};
|
||||
|
||||
static int qt2160_read_block(struct i2c_client *client,
|
||||
u8 inireg, u8 *buffer, unsigned int count)
|
||||
{
|
||||
int error, idx = 0;
|
||||
|
||||
/*
|
||||
* Can't use SMBus block data read. Check for I2C functionality to speed
|
||||
* things up whenever possible. Otherwise we will be forced to read
|
||||
* sequentially.
|
||||
*/
|
||||
if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
|
||||
|
||||
error = i2c_smbus_write_byte(client, inireg + idx);
|
||||
if (error) {
|
||||
dev_err(&client->dev,
|
||||
"couldn't send request. Returned %d\n", error);
|
||||
return error;
|
||||
}
|
||||
|
||||
error = i2c_master_recv(client, buffer, count);
|
||||
if (error != count) {
|
||||
dev_err(&client->dev,
|
||||
"couldn't read registers. Returned %d bytes\n", error);
|
||||
return error;
|
||||
}
|
||||
} else {
|
||||
|
||||
while (count--) {
|
||||
int data;
|
||||
|
||||
error = i2c_smbus_write_byte(client, inireg + idx);
|
||||
if (error) {
|
||||
dev_err(&client->dev,
|
||||
"couldn't send request. Returned %d\n", error);
|
||||
return error;
|
||||
}
|
||||
|
||||
data = i2c_smbus_read_byte(client);
|
||||
if (data < 0) {
|
||||
dev_err(&client->dev,
|
||||
"couldn't read register. Returned %d\n", data);
|
||||
return data;
|
||||
}
|
||||
|
||||
buffer[idx++] = data;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int qt2160_get_key_matrix(struct qt2160_data *qt2160)
|
||||
{
|
||||
struct i2c_client *client = qt2160->client;
|
||||
struct input_dev *input = qt2160->input;
|
||||
u8 regs[6];
|
||||
u16 old_matrix, new_matrix;
|
||||
int ret, i, mask;
|
||||
|
||||
dev_dbg(&client->dev, "requesting keys...\n");
|
||||
|
||||
/*
|
||||
* Read all registers from General Status Register
|
||||
* to GPIOs register
|
||||
*/
|
||||
ret = qt2160_read_block(client, QT2160_CMD_GSTAT, regs, 6);
|
||||
if (ret) {
|
||||
dev_err(&client->dev,
|
||||
"could not perform chip read.\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
old_matrix = qt2160->key_matrix;
|
||||
qt2160->key_matrix = new_matrix = (regs[2] << 8) | regs[1];
|
||||
|
||||
mask = 0x01;
|
||||
for (i = 0; i < 16; ++i, mask <<= 1) {
|
||||
int keyval = new_matrix & mask;
|
||||
|
||||
if ((old_matrix & mask) != keyval) {
|
||||
input_report_key(input, qt2160->keycodes[i], keyval);
|
||||
dev_dbg(&client->dev, "key %d %s\n",
|
||||
i, keyval ? "pressed" : "released");
|
||||
}
|
||||
}
|
||||
|
||||
input_sync(input);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static irqreturn_t qt2160_irq(int irq, void *_qt2160)
|
||||
{
|
||||
struct qt2160_data *qt2160 = _qt2160;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&qt2160->lock, flags);
|
||||
|
||||
__cancel_delayed_work(&qt2160->dwork);
|
||||
schedule_delayed_work(&qt2160->dwork, 0);
|
||||
|
||||
spin_unlock_irqrestore(&qt2160->lock, flags);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static void qt2160_schedule_read(struct qt2160_data *qt2160)
|
||||
{
|
||||
spin_lock_irq(&qt2160->lock);
|
||||
schedule_delayed_work(&qt2160->dwork, QT2160_CYCLE_INTERVAL);
|
||||
spin_unlock_irq(&qt2160->lock);
|
||||
}
|
||||
|
||||
static void qt2160_worker(struct work_struct *work)
|
||||
{
|
||||
struct qt2160_data *qt2160 =
|
||||
container_of(work, struct qt2160_data, dwork.work);
|
||||
|
||||
dev_dbg(&qt2160->client->dev, "worker\n");
|
||||
|
||||
qt2160_get_key_matrix(qt2160);
|
||||
|
||||
/* Avoid device lock up by checking every so often */
|
||||
qt2160_schedule_read(qt2160);
|
||||
}
|
||||
|
||||
static int __devinit qt2160_read(struct i2c_client *client, u8 reg)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_write_byte(client, reg);
|
||||
if (ret) {
|
||||
dev_err(&client->dev,
|
||||
"couldn't send request. Returned %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_read_byte(client);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev,
|
||||
"couldn't read register. Returned %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int __devinit qt2160_write(struct i2c_client *client, u8 reg, u8 data)
|
||||
{
|
||||
int error;
|
||||
|
||||
error = i2c_smbus_write_byte(client, reg);
|
||||
if (error) {
|
||||
dev_err(&client->dev,
|
||||
"couldn't send request. Returned %d\n", error);
|
||||
return error;
|
||||
}
|
||||
|
||||
error = i2c_smbus_write_byte(client, data);
|
||||
if (error) {
|
||||
dev_err(&client->dev,
|
||||
"couldn't write data. Returned %d\n", error);
|
||||
return error;
|
||||
}
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
|
||||
static bool __devinit qt2160_identify(struct i2c_client *client)
|
||||
{
|
||||
int id, ver, rev;
|
||||
|
||||
/* Read Chid ID to check if chip is valid */
|
||||
id = qt2160_read(client, QT2160_CMD_CHIPID);
|
||||
if (id != QT2160_VALID_CHIPID) {
|
||||
dev_err(&client->dev, "ID %d not supported\n", id);
|
||||
return false;
|
||||
}
|
||||
|
||||
/* Read chip firmware version */
|
||||
ver = qt2160_read(client, QT2160_CMD_CODEVER);
|
||||
if (ver < 0) {
|
||||
dev_err(&client->dev, "could not get firmware version\n");
|
||||
return false;
|
||||
}
|
||||
|
||||
/* Read chip firmware revision */
|
||||
rev = qt2160_read(client, QT2160_CMD_SUBVER);
|
||||
if (rev < 0) {
|
||||
dev_err(&client->dev, "could not get firmware revision\n");
|
||||
return false;
|
||||
}
|
||||
|
||||
dev_info(&client->dev, "AT42QT2160 firmware version %d.%d.%d\n",
|
||||
ver >> 4, ver & 0xf, rev);
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
static int __devinit qt2160_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct qt2160_data *qt2160;
|
||||
struct input_dev *input;
|
||||
int i;
|
||||
int error;
|
||||
|
||||
/* Check functionality */
|
||||
error = i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_BYTE);
|
||||
if (!error) {
|
||||
dev_err(&client->dev, "%s adapter not supported\n",
|
||||
dev_driver_string(&client->adapter->dev));
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
if (!qt2160_identify(client))
|
||||
return -ENODEV;
|
||||
|
||||
/* Chip is valid and active. Allocate structure */
|
||||
qt2160 = kzalloc(sizeof(struct qt2160_data), GFP_KERNEL);
|
||||
input = input_allocate_device();
|
||||
if (!qt2160 || !input) {
|
||||
dev_err(&client->dev, "insufficient memory\n");
|
||||
error = -ENOMEM;
|
||||
goto err_free_mem;
|
||||
}
|
||||
|
||||
qt2160->client = client;
|
||||
qt2160->input = input;
|
||||
INIT_DELAYED_WORK(&qt2160->dwork, qt2160_worker);
|
||||
spin_lock_init(&qt2160->lock);
|
||||
|
||||
input->name = "AT42QT2160 Touch Sense Keyboard";
|
||||
input->id.bustype = BUS_I2C;
|
||||
|
||||
input->keycode = qt2160->keycodes;
|
||||
input->keycodesize = sizeof(qt2160->keycodes[0]);
|
||||
input->keycodemax = ARRAY_SIZE(qt2160_key2code);
|
||||
|
||||
__set_bit(EV_KEY, input->evbit);
|
||||
__clear_bit(EV_REP, input->evbit);
|
||||
for (i = 0; i < ARRAY_SIZE(qt2160_key2code); i++) {
|
||||
qt2160->keycodes[i] = qt2160_key2code[i];
|
||||
__set_bit(qt2160_key2code[i], input->keybit);
|
||||
}
|
||||
__clear_bit(KEY_RESERVED, input->keybit);
|
||||
|
||||
/* Calibrate device */
|
||||
error = qt2160_write(client, QT2160_CMD_CALIBRATE, 1);
|
||||
if (error) {
|
||||
dev_err(&client->dev, "failed to calibrate device\n");
|
||||
goto err_free_mem;
|
||||
}
|
||||
|
||||
if (client->irq) {
|
||||
error = request_irq(client->irq, qt2160_irq,
|
||||
IRQF_TRIGGER_FALLING, "qt2160", qt2160);
|
||||
if (error) {
|
||||
dev_err(&client->dev,
|
||||
"failed to allocate irq %d\n", client->irq);
|
||||
goto err_free_mem;
|
||||
}
|
||||
}
|
||||
|
||||
error = input_register_device(qt2160->input);
|
||||
if (error) {
|
||||
dev_err(&client->dev,
|
||||
"Failed to register input device\n");
|
||||
goto err_free_irq;
|
||||
}
|
||||
|
||||
i2c_set_clientdata(client, qt2160);
|
||||
qt2160_schedule_read(qt2160);
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_irq:
|
||||
if (client->irq)
|
||||
free_irq(client->irq, qt2160);
|
||||
err_free_mem:
|
||||
input_free_device(input);
|
||||
kfree(qt2160);
|
||||
return error;
|
||||
}
|
||||
|
||||
static int __devexit qt2160_remove(struct i2c_client *client)
|
||||
{
|
||||
struct qt2160_data *qt2160 = i2c_get_clientdata(client);
|
||||
|
||||
/* Release IRQ so no queue will be scheduled */
|
||||
if (client->irq)
|
||||
free_irq(client->irq, qt2160);
|
||||
|
||||
cancel_delayed_work_sync(&qt2160->dwork);
|
||||
|
||||
input_unregister_device(qt2160->input);
|
||||
kfree(qt2160);
|
||||
|
||||
i2c_set_clientdata(client, NULL);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct i2c_device_id qt2160_idtable[] = {
|
||||
{ "qt2160", 0, },
|
||||
{ }
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(i2c, qt2160_idtable);
|
||||
|
||||
static struct i2c_driver qt2160_driver = {
|
||||
.driver = {
|
||||
.name = "qt2160",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
|
||||
.id_table = qt2160_idtable,
|
||||
.probe = qt2160_probe,
|
||||
.remove = __devexit_p(qt2160_remove),
|
||||
};
|
||||
|
||||
static int __init qt2160_init(void)
|
||||
{
|
||||
return i2c_add_driver(&qt2160_driver);
|
||||
}
|
||||
module_init(qt2160_init);
|
||||
|
||||
static void __exit qt2160_cleanup(void)
|
||||
{
|
||||
i2c_del_driver(&qt2160_driver);
|
||||
}
|
||||
module_exit(qt2160_cleanup);
|
||||
|
||||
MODULE_AUTHOR("Raphael Derosso Pereira <raphaelpereira@gmail.com>");
|
||||
MODULE_DESCRIPTION("Driver for AT42QT2160 Touch Sensor");
|
||||
MODULE_LICENSE("GPL");
|
Reference in New Issue
Block a user